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1. INTRODUCTION 

Recently, many quadrotor drones have been developed based on their size and purposes such as 
mini drones, hobby drones, professional drones, selfie drones, and FPV racing drone [1]. Mini drone or micro 
air vehicle (MAV) defined as a small scale UAV with mass < 0.1 kg get attention by educator/researcher due 
to it reliable and safe to perform in denied GPS space such as in the halls, schools, and more [2]. 

DJI and Parrot are among the well-known manufacturers that have established and commercialized 
quadrotor drones which cover most of those types including for educations. For instance, DJI developed 
Tello EDU, which can be programmed through Scratch 2.0, SDK 2.0, and even support Swift Playgrounds 
for 10S user [3]. In a while, Parrot has developed AR Drone 2.0, Rolling Spider and Mambo with all model 
support to be programmed via MATLAB/Simulink. AR Drone 2.0 toolbox is developed and shared by 
researchers while Simulink Support Package for Rolling Spider which recently upgraded to Simulink Support 
Package for Parrot Minidrones is add-on hardware support packaged provided by MATLAB based on 
Aerospace Blockset developed by MIT [4]. 

The mini drone’s quadrotor structure is simple, yet under-actuated and dynamically unstable system 
makes it complicated to design a full controller. Therefore, most of the research used common techniques 
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by creating two virtual inputs; roll angle and pitch angle for position control which required a very stabilized 
attitude controller [5-7]. Various control method has been presented such as an backstepping control [8-12], 
feedback linearization linear control [13, 14], sliding mode control (SMC) for attitude and altitude [15-19], 
proportional-integral-derivative (PID) [20-23] and LQR control [24, 25] and fuzzy logic control [26, 27]. 

This paper presents a PID control for under-actuated Parrot Mambo mini-drone focus on attitude 
stabilization during position control. The advantages of PID is its practicability and easy to be implemented 
just based on the system tracking error [28, 29]. The Parrot Mambo (6-DOF quadrotor mini drone), includes 
with ultrasonic, accelerometer, gyroscope, air pressure and down-facing camera sensors. It allows Bluetooth® 
Low Energy connection to deploy algorithms wirelessly via personal area network (PAN). This paper 
contributes a demonstration of simulation and experimental results of the PID controller applied 
to acommercial MAV (Parrot Mambo minidrone). 

This paper is organized as follows. Section 2 describes the nonlinear dynamic model based on 
the Parrot Mambo, and the design of the PID for both attitude and position control of the quadrotor. 
Section 3 presents the simulation and experiment results of controllers. Section IV is the conclusion 
of the paper. 


2. RESEARCH METHOD 
In this section, the nonlinear dynamics model of the Parrot Mambo mini-drone is presented using 
Newton-Euler formulation. 


2.1. Quadrotor dynamics 
In (1) [30] describes the translational dynamic model, while (2) represents the rotational dynamic 
model for X-model of the Parrot Mambo mini-drone, as shown in Figure 1. 
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where S and C stand for trigonometric operator ‘sin’ and ‘cos’ respectively, g is gravitational coefficient, 
m is quadrotor mass, @, O, p represent roll, pitch, and yaw respectively. [,,, lyy, and Izz is the total moment 
of inertia, J, is the rotor moment of inertia, Qg is the total of angular speed, U,, U2, U3, and U, are the control 
inputs. Table 1 shows the physical parameters of the Parrot Mambo, which is written in the source code 
obtained from the compilation of simulation model. 





Figure 1. Parrot Mambo minidrone 
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Table 1. Parrot Mambo model physical parameters 


Specification Parameter Unit Value 
Quadrotor mass m kg 0.063 
Lateral moment arm l m 0.0624 
Thrust coefficient b Ns? 0.0107 
Drag coefficient d Nms?* 0.78264 x 1073 
Rolling moment of inertia ki kgm? 0.0000582857 
Pitching moment of inertia Ly kgm? 0.0000716914 
Yawing moment of inertia i kgm? 0.0001 
Rotor moment of inertia J kgm? 0.1021 x 107° 
2.2. Attitude controller 
The altitude controller is designed using classical PID as: 
U; = kpe; + ki f e; dt + kpê; (i = 9, 8,) (3) 


where e; = ig —i and é; = ig —i are the error and derivative error between the desired signal and actual 
signal, and kp, kj, and k} are the PID gains parameter (i = ¢, 0, W). 


2.3. Altitude controller 
The altitude controller is designed using classical PID with a gravity compensator controller 
and described as: 


U, =kZe, +k? fe, +kZé, +mg (4) 


where e, = Za — Z and é, = Zq — Z are the error and derivative error between the desired signal and actual 
signal, and k$, ký, and kf are the PID gain parameter. 


2.4. Position controller 
For the position control, since the MAV is operating around hover, the small-angle assumption 
(Spa = bq, $0qg = 9g and Chg = COq = 1) is applied to simplify (1) as: 


a. 
xX = Gore + Oac) 


i = =U, (—haCp + OgSV) (5) 


Therefore, from (4), a virtual control signal is proposed to control the x and y position and can be 
implemented as: 


Pa = (u,Sp m uyC) 
Oa = (u,Cp + uy Sp) (6) 


where uy and u, are the inputs control signal designed using PID as: 


u, = kpe, + kj | ey + kė 


Uy =kpey +k; fey +kjeé, (7) 


3. RESULTS AND DISCUSSION 
In this section, simulation and real-time implementation are carried out to verify the performance 
of the Parrot Mambo mini drone. 


3.1. Simulation results 

Based on the dynamics of quadrotor MAV in (1, 2) and PID controller in (3, 4, 7), the simulations 
were conducted through MATLAB/Simulink® R2019a by setting third-order solver with 0.005 second 
sampling period. The dynamics z, œ, 0, and w were evaluated with the presences of external disturbances, a 
normal Gaussian noise of force defined as d(t) = [(0,0.5)N, (0,0.5)N, (0,0.5)N, (0,0.5)N]’ at the time 
interval d(t) > 10 s [15]. Figure 2(a) shows the altitude and the attitude response of the PID controller with 
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a with the presence of external disturbance. As shown, the PID controller able to converge 
to zero even with the presence of external disturbances after 10 s. Figure 2(b) shows the controller control 
inputs were sensitive to the noise after 10 seconds period. 
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Figure 2. PID controller with the presence of external disturbance, (a) Altitude and attitude response, 
(b) The control inputs 


3.2. Experimental results 

By using the Simulink Support Package for Parrot minidrones, the Parrot Mambo algorithm 
is deployed via Bluetooth. The state estimation was predefined in the provided package. The sensor fusion 
algorithm was designed using a complementary filter and Kalman filter to process onboard sensors such as 
the ultrasonic sensor, IMU, air pressure sensor, and optical flow sensor [2]. Figure 3 shows an experimental 
setup for MAV using Simulink for simulation and straight away can be programmed wirelessly through 
Bluetooth for real-time implementation. 

The information from the real-time experiment is obtained from built-in memory in Parrot Mambo 
mini drone which is designed to log essential data such as sensors, positions (x, y, z) and rotational (roll, 
pitch, yaw). Initially, the desired altitude is set at Z = —1.1 meter, while for the rotational angle yaw is set as 
W = 0. Table 2 shows the PID parameters used in this experiment. 


Quadcopter Flight Simulation Model - Mambo 


Flight Commands Flight Control System - Code Generation Simulation Model 


Flight Visualization 











Figure 3. Experimental setup for MAV 
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Table 2. PID parameters the Parrot Mambo controller 


Kp Ki Kd 
Roll, $ 0.011 0.01 0.0028 
Pitch, 0 0.013 0.01 0.002 
Yaw, Y 0.004 0.02 0.012 

Z 0.800 0.24 0.500 
Y -0.2 0.002 0.1 
X 0.2 0.05 -0.1 


3.2.1. Hovering (altitude tracking without perturbations) 

In Figure 4(a), altitude z can reach 1.1 m as the desired with slightly oscillations contra 
to the simulation (nominal model). The system performances are affected due to parametric uncertainties, 
i.e., hull is included for safety, which increased the weight and inertia moments, and noise from onboard 
sensors. The roll angle and pitch angle capable of following the desired response from the virtual controller, 
and yaw angle were forced to converge to zero. Figure 4(b) shows motors angular velocities during hovering. 
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Figure 4. Parrot Mambo minidrone in hover position, (a) Altitude and attitude responses, 
(b) Motors angular velocities 


3.2.2. Hovering (altitude tracking with perturbations) 

In this experiment, an external disturbance consist of a force by hand is applied twice to the 
quadrotor at 10 s and 15 s during hovering. Since the Parrot Mambo is small MAV, a slight perturbation will 
affect its performances. Figure 5(a) shows the output response of the system subject to an external 
perturbation. Figure 5(b) shows motors angular velocities during hovering subject to an external perturbation. 


3.2.3. Position tracking 

In this experiment, the initial position of the Parrot Mambo mini-drone is set as [x,y,z]? = 
[0,0,0]" m and the desired final position of the Parrot Mambo minidrone is set to [x,y,z]? = [1,1, —1.1]f m. 
In order to accomplish this, a Stateflow bock is used to design the path planning. On the beginning, the Parrot 
Mambo minidrone is set to hover by setting the output as [x,y,z]? = [0,0,—1.1]’ m. After 4 seconds, the 
MAV is set to move forward by [x,y,z]’ = [1,0,—1.1]’ m and then after 15 seconds the MAV is set to 
move to the right side by [x,y,z]? = [1,1,-—1.1]’ m, and finally hover at that condition afterward. Figure 
6(a) shows the output response of the Parrot Mambo minidrone to follow the path as planned. From the 
figure, trajectory x and y is forced to converge to dedicated output with slightly oscillation due to parameter 
uncertainties as mention above. Nevertheless, the output response of the attitude @, 0, yw, and altitude z shows 
great stability in following the desired signal. Figure 6(b) shows motors angular velocities during 
position tracking. 
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Figure 5. Parrot Mambo minidrone in hover position under external perturbations, (a) Altitude and attitude 
responses, (b) Motors angular velocities 
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Figure 6. Parrot Mambo mini-drone position tracking,(a) Position and Attitude responses, 
(b) Motors angular velocities 


4. CONCLUSION 

This paper presents a position and an attitude control implemented on the commercial MAV. 
For the attitude control, a PID control was proposed to stabilize the MAV subjected to small perturbation. 
Furthermore, for the position control, a PID controller with gravity compensator was utilized to ensure 
quadrotor able to manoeuvre successfully to the desired position by following the path as planned. Finally, in 
the conducted simulations and experiments on the Parrot Mambo minidrone with small perturbations, the PID 
controller demonstrates the MAV can achieve attitude stabilization, hover at desired altitude and then follow 
the desired trajectory as planned. For future work, a robust controller such as the adaptive PID or the sliding mode 
control techniques can be simulated and implemented on this commercial MAV 
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